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DESCRIPTION 



CONTROL METHOD FOR TWIN SYNCHRONIZATION 



<Technical Field> 

The present invention relates to an appl ied machine 
applied to a high speed positioning control for gantry 
type machines such as a high speed conveying machine or 
^other machines, and more particularly to a control method 
for high speed and highly accurate uses. 

<Related Art> 

In recent years , in the high speed and highly accurate 
conveying machine of an industrial machine field, what 
is called a gantry type machine in which two axes are 
synchronously operated has been introduced. When a 
synchronization between the axes is carried out in the 
gantry type machine, a high speed and highly accurate 
synchronous operation is hardly realized in a machine 
low in its rigidity and having torsion or backlash. 

Usually, to reduce a deviation between the two axes, 
a method has been employed in which the same position 
command and the speed command are respectively 
distributed to the axes from a controller to adjust the 
gain of a position controlling and speed controlling loop 
of each axis to a high gain, an integration is utilized 




in the position controlling and speed controlling loop 
to eliminate the deviation during a control and a speed 
feed forward process is carried out to improve a 
responsiveness for each axis and reduce the deviation 
between the two axes (for instance, see JP-A-11-305839) • 
However, in the case of a gantry type machine 
structure, below-described problems arise. 

(1) Since the two axes are mechanically fastened to each 
other, the machine with high rigidity that can withstand 
a high gain is hardly obtained. 

(2) There are necessarily an installation error of the 
above-described machine, an attaching error of a position 
sensor, distortion and backlash of each axis. 

(3) Although the gain is increased to reduce the 
deviation between the two axes , the two axes interfere 
with each other during a control operation and torque 
outputted respectively from the axes causes a disturbance 
to give an adverse effect to the vibration of a pedestal 
or accuracy. 

Thus, it is an object of the present invention to 
provide a twin synchronization method that can avoid the 
above-described problems for a machine having a gantry 
type structure and can easily realize a high speed and 
highly accurate operation. 
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<Disclosure of the Invention> 

To achieve the above-described object, according 
to the present invention 1 , there is provided with a control 
method for a twin synchronization in which two motors 
for driving two axes mechanically fastened to each other 
by a fastening part are synchronously operated, the 
control method including the steps of: operating one of 
the two axes at low speedby a position control and allowing 
the other axis to freely run and follow the one axis and 
perform a return to the origin; measuring a positional 
deviation between the one axis and the other axis at an 
arbitrary pitch; storing the positional deviation 
corresponding to a position where the one axis travels 
in a data base as a function; directly disturbing one 
position command to the one axis as amain position command; 
• and distributing the position command- to the other axis 
as a position command corrected by using the function 
stored in the data base to perform an operation. 

In order to reduce the synchronization error of the 
two axes, it is important to firstly determine how a return 
to the origin operation is performed. In this case, when 
the return to the origin operation is firstly performed, 
if the two axes are electrically operated at the same 
time under a speed control and a position control, a motor 
of each axis gives a stress to a machine side . Accordingly, 
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characteristics such as a distortion of a machine itself 
cannot be grasped. Therefore, in driving upon return to 
the origin operation, a main axis (either of the two axes 
may be used) is operated at low speed by controlling a 
position and the other axis is allowed to freely run and 
follow the main axis and the return to the origin operation 
is carried out by a single sided drive. 

Originally, in the case of a mechanically and ideally 
fastened structure, the deviation between the two axes 
is to be 0 at any position. However, in an actual machine, 
since there are necessarily an installation error, the 
attaching error of a position sensor, a distortion and 
backlash of each axis, the deviation between the two axes 
necessarily arises depending on positions. Therefore, 
the deviation between the two axes is automatically 
measured at" the arbitrary pitch and=recorded in the data 
base. Also at this time, when the two axes are 
electrically operated at the same time under the speed 
control and the position control like during the return 
to the origin operation, the motor of each axis gives 
a stress to the machine side, so that the characteristics 
such as the distortion of the machine itself cannot be 
grasped. Thus, in driving during the measurement, the 
main axis is operated at low speed by controlling the 
position and the other axis is allowed to freely run and 
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follow the main axis to measure the deviation between 
the two axes . 

To synchronously operate the two axes, one position 
command is distributed to the two axes as the main position 
command. The main position command to be distributed is 
directly distributed to the first axis. The function 
recorded in the data base is used, the main position command 
is used as an input and an output thereof is used, so 
that the main position command - an output value of the 
function = the position command of the other axis (the 
position command to the second axis) , that is, a position 
command to which a correction considering a torsion part 
is added is distributed to the other axis. 

A high speed and highly accurate synchronization 
control that cannot be realized by a usual control system 
can be realized by the above-described means without- 
receiving an adverse effect due to the rigidity or the- 
distortion of a machine system. 

Further, according to the present invent ion 2 , there 
is provided with the control method for a twin 
synchronization according to the present invention 1, 
wherein the deviation measured at the arbitrary pitch 
undergoes a linear interpolating process in the function 
to output the obtained deviation. 

In the invention defined in claim 2, since the 
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deviation measured at the arbitrary pitch is arbitrarily 
changed in accordance with a moving distance, the linear 
interpolating process is carried out in the function to 
output the obtained deviation. 

Further, according to the present invent ion 3 , there 
is provided with the control method for a twin 
synchronization according to the present invention 1 or 
2, wherein in the position command to the other axis, 
a travel speed is employed as a parameter to move forward 
the phase of a corrected value. 

In the invention defined in claim 3, when the travel 
speed of the machine is increased, a processing time for 
carrying out a correction itself is undesirably delayed. 
Accordingly, a function for using the travel speed as 
the parameter to move forward or lead the phase of the 
corrected- - value • -is employed ' to per form - the • * 
synchronization control. 

Further, according to the present invent ion 4 , there 
is provided with the control method for a twin 
synchronization according to the present invention 1, 
further including the steps of: detecting the position 
of a center of gravity of the fastening part; preparing 
a function for forming an inertia compensating gain of 
each axis by using a position signal as an input; changing 
the inertia compensating gain in the position of the center 
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of gravity of the fastening part; and adding a necessary 
torque calculated on the basis of an acceleration obtained 
from the position commands of the two axes and a mass 
of each axis to a torque command. 

In the invention defined in claim 4, when an X-axis 
by which a Yl axis is fastened to a Y2 axis is movable, 
the position of the center of gravity of the machine moves, 
so that synchronization accuracy is deteriorated. To 
inertia-correct the deterioration of the synchronization 
accuracy, a position where the X-axis moves is grasped. 
A function for forming the inertia compensating gain Ktf f x 
is prepared by using a position signal as an input to 
change the inertia compensating gain Ktf fx at the position 
of the X-axis. An inclination is based on a change of 
a load applied to the axis in accordance with the change 
of the center of gravity. • • - • 

Thus, a high speed and highly accurate 
synchronization control that cannot be realizedbyausual 
control system can be realized without receiving an 
adverse effect due to the rigidity or the distortion of 
a machine system and the change of the center of gravity 
due to the movement of the X-axis of the fastening part. 

<Brief Description of the Drawings> 

Fig. 1 shows a structure in an embodiment of the 
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present invention. Fig. 1(a) is a front view. Fig. 1(b) 
is a side view and Fig. 1(c) is a plan view. 

Fig. 2 is a control block diagram in a first 
embodiment of the present invention. 

Fig. 3 is a flowchart showing a procedure for forming 
a torsionpart correcting function in the first embodiment 
of the present invention. 

Fig. 4 is a diagram showing an output example of 
a torsion correcting amount in the first embodiment. 

Fig. 5 is a diagram showing a relation between a 
main position command, a main torque command and a torque 
command in a correcting side when a torsion is not corrected 
in the first embodiment of the present invention. 

Fig. 6 is a diagram showing a relation between the 
main position command, the main torque command and the 
torque command in the correcting side when the* torsion - 
is corrected in the first embodiment of the present 
invention . 

Fig. 7 is an inertia correction control block diagram 
in a second embodiment of the present invention. 

Fig. 8 is a detailed explanatory view for forming 
an inertial correcting gain in the second embodiment of 
the present invention. 

Fig. 9 is a diagram showing a relation between the 
main position command, the main torque command and the 
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torque command in the correcting side when there is not 
an inertia correction control in the second embodiment 
of the present invention. 

Fig. 10 is a diagram showing a relation between the 
main position command, the main torque command and the 
torque command in the correcting side when there is the 
inertia correction control in the second embodiment of 
the present invention. 

In the drawings, reference numeral 1 designates a 
controller. 2, 2-1 and 2-2 designate servo drives. 3 
designates a moving element. 4 designates a stator. 5 
designates a linear scale. 6 designates a fastening jig. 
7-1 designates a motor of a first axis. 7-2 designates 
a motor of a second axis. 11 designates a main position 
command generating part. 12 designates an interpolating 
part ; ■ 13 designates a phase lead compensating part. • 14 
designates a function part for generating a torsion part * 
corrected value. 15 and 16 designate differential 
operating parts. 17 designates a scale converting part. 
18 designates a gain amplifier . 21 designates a position 
loop control part. 22 designates a speed loop control 
part. 23 designates a current loop control part. 24 
designates a linear scale . 31 designates a main position 
command generating part. 32 designates an interpolating 
part . 3 3 and 34 designate differential operating parts. 
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35 and 37 designate inertia calculating parts. 36 
designates a yl-axis torque FF compensating part. 38 
designates a y2~axis torque FF compensating part 39 
designates an X-axis position detecting part. 40 
designates a function part for generating an inertia 
compensating gain. 41 and 42 designate inertia 
compensating parts . 

<Best Mode for Carrying Out the Invention> 

Now^ a first embodiment of the present invention 
will be described below by referring to the drawings. 
Fig. 1 shows the structure of a first embodiment 
of the present invention formed by using a linear motor. 
Fig. 1(a) is a front view. Fig. 1(b) is a side view and 
Fig. 1 (c) is a plan view. In the drawing, reference 
numeral 1 designates a controller, 2 -designate^' a- servo 
drive, 3 designates a moving element, 4 designates a stator , 
5 designates a linear scale and 6 designates a fastening 
jig for mechanically fastening two axes together. 

Fig . 2 is a control block diagram of this embodiment . 
In Fig. 2, the controller 1 includes the main position 
command generating part 11, the interpolating part 12, 
the phase lead compensating part 13, the function part 
14 for generating a torsion part corrected value, the 
differential operating parts 15 and 16, the scale 
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converting part 17 and the gain amplifier 18. Further, 
the servo drives 2-1 and 2-2 include the position loop 
control parts 21, the speed loop control parts 22 and 
the current loop control parts 23. In the drawing, 7-1 
designates the motor of the first axis, 7-2 designates 
the motor of the second axis and 24 designates the linear 
scales for respectively detecting the positions of the 
moving elements of the motors 7-1 and 7-2. 

In the control block diagram of Fig. 2, in the 
controller 1, a main position command is firstly generated 
by the main position command generating part 11 . The main 
position command is interpolated in the interpolating 
part 12 to generate a main position command from hour 
to hour. To the servo drive 2-1 of the first axis, the 
main position command is generated for a main axis, the 
posit ion- command is two-stage time differ entiated in the 
differential operating parts 15 and 16 of two stages, 
the differentiated position command is scale-converted 
in the scale converting part 17 and the converted position 
command is multiplied by a gain Ktf f in the gain amplifier 
18. Thus, T-FF (torque feed forward) is generated. 

To the second servo drive 2-2 of the second axis, 
the position command of the main axis from hour to hour 
is used as an input and a torsion part correcting function 
generated in the function part 14 for generating a torsion 
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part corrected value is used to generate a torsion 
correcting position coiamand corresponding to the position 
command that passes . Thus , the main position command from 
hour to hour - the torsion correcting position command 
= a position command of the second axis is generated and 
outputted to the servo drive 2-2 of the second axis. 

Fig. 3 is a flowchart showing a procedure for 
generating a torsion part correcting function in the 
function part 14 for generating a torsion part corrected 
value • 

Step 1: Return to the origin 

The position of the first axis as the main axis is 
controlled and the second axis as the other axis is allowed 
to freely run and reset to zero. 

Step 2: Measurement of torsion data between two axes 

-A method is carried out in which a devd^at ion^be tween • • 

two axes (position FB of first axis - position FB of second 
axis) is automatically measured at an arbitrary pitch 
to store the deviation in a data base. At this time, when 
the two axes are electrically operated at the same time 
under a speed control and a position control like during 
the return to the origin operation, a motor of each axis 
gives a stress to a machine side. Thus, characteristics 
such as the distortion of the machine itself cannot be 
grasped. Accordingly, in driving during the measurement. 
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the main axis (any one of the two axes may be used) is 
operated at low speed by controlling a position and the 
other axis is allowed to freely run and follow the main 
axis to measure the deviation of the two axes. 
Step 3: Generate function of torsion data 

A function is generated that has a travelling 
position as an input and the deviation between the axes 
measured in the step 2 as an output. Since the input 
arbitrarily changes depending on a moving distance, the 
deviation measured at the arbitrary pitch in the step 
2 is subjected to a linear interpolating process in the 
function and the obtained deviation is outputted. 

In order to improve the responsiveness upon 
acceleration and deceleration, the position commands are 
simultaneously outputted to the first axis and the second 
axis in the servo drive 2-1 and 2-2 sides . -As such a 
synchronization" control method, a position following 
control method in a position synchronization type speed 
control system disclosed in JP-A- 0 6-2 8 03 6 that is filed 
by the applicant of the present invention may be employed. 

For a case in which a correction cannot be made only 
by a quantity of correction generated by an automatic 
measuring operation, a function for manually adding a 
quantity of correction as an offset value is also prepared . 
Further, for a case in which when the travelling speed 
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of the machine is increased, a processing time for 
performing a correction itself is undesirably delayed, 
a function for leading the phase of a corrected value 
by using the travelling speed as a parameter is also 
prepared . 

Fig . 4 is a graph showing a torsion corrected quantity 
specifically measured by the procedure shown in Fig. 3. 

A designates a quantity of torsion measured by 
actually attaching a laser displacement gauge to the 
machine. B designates a quantity of torsion measured by 
the procedure shown in Fig. 3 . Since the above-described 
offset quantity is added to the former, the quantity of 
torsion is the more offset for the offset quantity. 
However, it is understood that the quantity of torsion 
of the machine can be accurately measured by the method 
shown "in Fig .- "-3 -. • 

Figs. 5 and' 6 respectively show relations between 
a main position command, a main torque command and a torque 
command in a correcting side. Fig. 5 shows an example 
when a method of this embodiment is not used. Fig. 6 shows 
an example when the method of this embodiment is used. 
In Fig. 6, it is understood that the deviation between 
the two axes is extremely improved as high as about 1/3. 
As described above, the method of the present invention 
is used so that a synchronization control that cannot 
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be realized hitherto can be realized in the gantry type 
machine using the linear motor. 

Now, a second embodiment of the present invention 
will be described below. 

Fig* 7 is a block diagram of a controller showing 
a second embodiment of the present invention. 

In Fig. 7, the controller 1 includes a main position 
command generating part 31, an interpolating part 32, 
differential operating parts 33 and 34, inertia 
calculating parts 35 and 37, a yl-axis torque FF (feed 
forward) compensating part 36, a y2-axis torque FF 
compensating part 38, an X-axis position detecting part 
39, a function part 40 for generating an inertia 
compensating gain and inertia compensating parts 41 and 
42 . 

In the second embodiment , an inert ia correction when=- — 

an X-axis movesis controlled by a torque FF (feedforward) 
compensation . 

In a twin synchronization type (a gantry type) 
machine, when a fastening jig part 6 (X-axis) moves and 
twin driving parts (Yl and Y2 axes) are synchronously 
operated, the position of a center of gravity moves . Thus , 
synchronization accuracy is deteriorated. 

Thus, to inertia-correct the deterioration of 
accuracy due to the movement of the position of a center 
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of gravity of the machine, a position where the X-axis 
moves is grasped by the X-axis position detecting part 
39. A position signal thereof is used as an input to 
prepare an inertia compensating gain Ktf fx in the function 
part 40 for generating an inertia compensating source 
and change the inertia compensating gain Ktffx at the 
position of the X-axis (see Fig, 7(a)). 

The inclination of the inertia compensating gain 
Ktffx is based on the change part of a load exerted on 
the axis due to the change of a center of gravity. That 
is, an object of the X-axis moves to change the center 
of gravity of the X-axis, so that the load exerted on 
the Yl and Y2 changes. Accordingly, a correction is 
carried out only on the basis of the change part. 

As for the inclination, a neutral position of the 
X-axis is firstly subtracted from a current^position of 
the X-^axis. 'The obtained value is multiplied "by an 
adjusting coefficient, namely, a coefficient for 
adjusting so that an outputted quantity of corrected 
torque corresponds to an actual entire torque command. 
To apply the inclination to the Yl and Y2 axes in accordance 
with the position of the X-axis, for the Yl, the obtained 
value is subtracted from 1.0, and for the Y2, 1.0 is added 
to the obtained value, as shown in Fig. 8, so that inertia 
compensating coefficients Ktffyl and Ktffy2 of the Yl 
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and Y2 axes are generated. 

The Ktffyl and Ktffy2 are used to calculate masses 
Wwyl' and Wwy2' when the X-axis moves in accordance with 
a following formula in the inertia compensating parts 
41 and 42, Wwyl and Wwy2 designate masses of the Yl axis 
and the Y2 axis before the axes move. 
Wwyl' = Wwyl x Ktffyl 
Wwy2' = Wwy2 x Ktffy2 

An actual torque FF command is generated in the main 
position command generating part 31. A main position 
command interpolated in the interpolating part 32 is 
two-stage time differentiated in the differential 
operating parts 33 and 34 to generate an acceleration 
aref . In the inertia calculating parts 35 and 37, the 
acceleration aref, the masses Wwyl' and Wwy2 after the 
Yi axi-s and the ^2 axis move, the mass Wt^ of- the fastening - - 
jig 6, the mass Wm of a motor and the torque FL of the 
load are used to calculate a torque necessary upon 
operation in accordance with following formulas. 
({(Wwyl' + Wt + Wm) x acceleration aref + FL) /rated thrust ) 
X 100 % 

( ( (Wwy2 ' + Wt + Wm) x acceleration aref + FL) / rated thrust ) 
X 100 % 

The torque calculated in such a way is inputted to 
the yl-axis torque FF compensating part 36 and the y2- 
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axis torque FF compensating part 38 as compensating torque 
and added to a torque command of a driver side to improve 
the synchronization accuracy. 

Figs. 9 and 10 show relations between the main 
position command, a main torque command and a torque 
command in a correcting side. Fig. 9 shows an example 
when a method of this embodiment is not used. Fig. 10 
is an example when the method of this embodiment is used. 
In Fig. 9, when the X-axis is movable, a quantity of a 
torque FF of the Yl does not correspond to an actually 
required torque command of the Yl, a deviation between 
the two axes is generated. In Fig. 10, since the quantity 
of the torque FF of the Yl corresponds to the actually 
required torque command of the Yl in accordance with the 
correction, it is understood that the deviation between 
the two axes is extremely improved as- high- as -about -l / 5-. 

<Indus trial Applicabili ty> 

As described above, according to the present 
invention, one of the two axes is operated at low speed 
by a position control and the other axis is allowed to 
freely run and follow the one axis and a return to the 
origin is performed. A positional deviation between the 
one axis and the other axis is measured at an arbitrary 
pitch and the positional deviation corresponding to a 

18 



position where the one axis travels is stored in a data 
base as a function. One position conunand is directly 
distributed to the one axis as a main position command 
and the position command is distributed to the other axis 
as a position command corrected by using the function 
stored in the data base to perform an operation. Thus, 
a twin synchronization control that can realize a high 
speed and highly accurate operation can be easily 
realized . 

Further, the position of a center of gravity of the 
fastening part is detected. A function for generating 
an inertia compensating gain of each axis is prepared 
by using a position signal thereof as an input. The 
inertia compensating gain is changed in the position of 
the center of gravity of the fastening part . A necessary 
torque caleulated on the basis of an acceleration obtained • - 
from the position commands of the two axes and a mass 
of each axis is added to a torque command. Thus, since 
a quantity of the torque feed forward of one of the two 
axes corresponds to an actually required torque command, 
the deviation between the two axes can be extremely 
reduced . 
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